#include "SweetSpot1.h"
#include "StartShooterMotors.h"
#include "Timeout.h"
#include "FireShooterSensor.h"
#include "RaiseAngle.h"
#include "DropAngle.h"

SweetSpot1::SweetSpot1() {
        // Add Commands here:
        // e.g. AddSequential(new Command1());
        //      AddSequential(new Command2());
        // these will run in order.

        // To run multiple commands at the same time,
        // use AddParallel()
        // e.g. AddParallel(new Command1());
        //      AddSequential(new Command2());
        // Command1 and Command2 will run in parallel.

        // A command group will require all of the subsystems that each member
        // would require.
        // e.g. if Command1 requires chassis, and Command2 requires arm,
        // a CommandGroup containing them would require both the chassis and the
        // arm.
//	AddSequential(new DropAngle());
//	AddSequential(new Timeout(0.5));
	AddSequential(new RaiseAngle(147 , 0.001));
	AddSequential(new StartShooterMotors(0.68, 0));
	/*
	AddSequential(new Timeout(2));
	AddSequential(new FireShooterSensor());
	AddSequential(new Timeout(1.5));
	AddSequential(new FireShooterSensor());
	AddSequential(new Timeout(1.5));
	AddSequential(new FireShooterSensor());
	AddSequential(new Timeout(1.5));
	AddSequential(new FireShooterSensor());
	*/
}
